Claims 

What is claimed is: 

1 . A method for planning the path of a vehicle, the method comprising: 

establishing a perimeter path plan of a vehicle including a defined perimeter; 
establishing a region-filling path plan of the vehicle within the defined 
perimeter; 

establishing a point-to-point path plan of a vehicle including a segment of at 
least one of the region-filling path plan and the perimeter path plan; and 

forming a preferential composite path plan based on the established perimeter 
path plan, the region-filling plan, and the point-to-point path plan. 

2. The method according to claim 1 wherein the forming comprises: selecting 
preferential components of two or more of the established plans to form the 
preferential composite plan consistent with minimizing an economic cost of 
traversing the composite path plan by the vehicle. 

3. The method according to claim 1 wherein the forming comprises: 

estimating candidate path distances of corresponding candidate composite 
path plans; 

selecting the preferential composite path plan as the candidate composite 
path plan having a shortest estimated distance; and 

defining the preferential composite path plan as components of two or more of 
the established plans. 

4. The method according to claim 1 wherein the preferential composite path plan 
comprises an assembly of segments selected from at least two of the established 
perimeter plan, the established point-to-point path plan, and the established region- 
filling path plan; an order of the assembly based on coordination that minimizes an 
overall composite economic cost of the preferential composite path plan. 
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5. The method according to claim 1 wherein the established perimeter path plan 
comprises a series of interconnected segments; the established point-to-point path 
plan comprises a series of interconnected segments; the established region-filling 
path plan comprises a series of interconnected segments, each of the 
interconnected segments selected from the group consisting of a generally linear 
segment and an arc. 

6. The method according to claim 1 wherein the establishing of the perimeter path 
plan comprises: 

defining vehicular constraints of the vehicle that relate to navigation of the 
vehicle; 

collecting location data points by traversing a perimeter of a work area to be 
covered by a vehicle; 

filtering the collected data to provide filtered data of critical data points to 
reduce high frequency noise in the collected data; and 

selecting a path for the vehicle that is composed of segments that intercept 
the critical data points. 

7. The method according to claim 6 wherein the segments comprise tangential arcs. 

8. The method according to claim 6 wherein the filtering further comprises: 

dividing the collected data into at least one of a temporal sequence and a 
spatial sequence indicative of vehicular position with reference to a first axis and a 
second axis, the first axis being generally perpendicular to the second axis; 

accessing pre-filtered magnitude data of the collected data to determine 
critical magnitude data; 

applying a zero-phase filtering to the collected data to determine critical phase 

data; 

identifying the critical data points based on the critical magnitude data and the 
critical phase data. 
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9. The method according to claim 6 wherein the filter further comprises: 

calculating a cutoff frequency of a filter based on at least one of a maximum 
velocity of the vehicle during the collecting step, minimum turn radius, duration 
between samples collected during the collecting step, and a damping factor for the 
filter; 

calculating filter coefficients for the filter. 

10. The method according to claim 9 wherein the filter comprises a Butterworth filter. 

1 1 . The method according to claim 6 wherein the selection further comprises: 

calculating a path angle at each point in the path; 
looping through the critical points while skipping candidate points; 
determining a distance from a candidate point to an arc; 
designating the candidate point as a disregarded point if the determined 
distance is greater than a threshold. 

12. The method according to claim 6 wherein the selection further comprises: 

designating the candidate point as a critical point if the determined distance is 
less than or equal to a threshold and revising the looping to include the newly 
designated critical point. 

13. The method according to claim 1 wherein establishing the point-to-point path 
plan comprises: 

establishing a minimum turning radius of a vehicle; 

defining a starting point and starting heading of the vehicle, the starting point 
lying within an operational zone of the vehicle; 

defining a destination point and destination heading of the vehicle, the 
destination point lying with the operation zone; 

scanning the operational zone between the starting point and the destination 
point to identify any obstacle and a velocity vector associated with the obstacle; and 

determining a path between the starting point and the destination point 
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consistent with avoidance of a collision with the obstacle and the established 
minimum turning radius. 

14. The method according to claim 8 further comprising: 

defining an obstacle, as a stationary object, within the operation zone 
between the starting point and destination point. 

15. The method according to claim 9 wherein the obstacle is defined as a polygonal 
shape in which the vehicle must keep out in accordance with a navigational rule. 

16. The method according to claim 1 wherein the path is determined by identifying a 
list of candidate paths and searching the candidate paths for a preferential path with 
a minimal economic cost of traversal. 

17. The method according to claim 1 1 wherein the preferential path comprises the 
shortest path between the starting point and the destination point that avoids 
intersecting with any obstacle by a desired margin of safety. 

18. The method according to claim 1 1 wherein the searching further comprises: 

constructing a visibility graph of edges and nodes; 
searching the visibility graph with an A* algorithm; 

applying at least one of a straight line cost filter and a maximum allowed touch 
filter to eliminate solutions of the A* algorithm to enhance efficiency of the searching. 

19. A method for establishing a point-to-point path plan, the method comprising: 

establishing a minimum turning radius of a vehicle; 

defining a starting point and starting heading of the vehicle, the starting point 
lying within an operational zone of the vehicle; 

defining a destination point and destination heading of the vehicle, the 
destination point lying with the operation zone; 

scanning the operational zone between the starting point and the destination 
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point to identify any obstacle and a velocity vector associated with the obstacle; and 

determining a path between the starting point and the destination point 
consistent with avoidance of a collision with the obstacle and the established 
minimum turning radius. 

20. The method according to claim 19 further comprising: 

defining an obstacle, as a stationary object, within the operation zone 
between the starting point and destination point. 

21 . The method according to claim 19 wherein the obstacle is defined as a 
polygonal shape in which the vehicle must keep out in accordance with a 
navigational rule. 

22. The method according to claim 19 wherein the path is determined by identifying 
a list of candidate paths and searching the candidate paths for a preferential path 
with a minimal economic cost of traversal. 

23. The method according to claim 19 wherein the preferential path comprises the 
shortest path between the starting point and the destination point that avoids 
intersecting with any obstacle by a desired margin of safety. 

24. The method according to claim 19 wherein the searching further comprises: 

constructing a visibility graph of edges and nodes; 
searching the visibility graph with an A* algorithm; 

applying at least one of a straight line cost filter and a maximum allowed touch 
filter to eliminate solutions of the A* algorithm to enhance efficiency of the searching. 

25. A system for planning the path of a vehicle, the system comprising: 

a perimeter training module for establishing a perimeter path plan of a vehicle 
including a defined perimeter; 

a region-filling module for establishing a region-filling path plan of the vehicle 
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within the defined perimeter; 

a point-to-point planning module for establishing a point-to-point path plan of a 
vehicle including a segment of at least one of the region-filling path plan and the 
perimeter path plan; and 

a coordination module for forming a preferential composite path plan based 
on the established perimeter path plan, the region-filling plan, and the point-to-point 
path plan. 

26. The system according to claim 25 wherein the coordination module comprises 
preferential components of two or more of the established plans to form the 
preferential composite plan consistent with minimizing an economic cost of 
traversing the composite path plan by the vehicle. 

27. The system according to claim 25 wherein the coordination module comprises: 

an estimator for estimating candidate path distances of corresponding 
candidate composite path plans; 

a selector for selecting the preferential composite path plan as the candidate 
composite path plan having a shortest estimated distance; and 

a definer for defining the preferential composite path plan as components of 
two or more of the established plans. 

28. The system according to claim 25 wherein the preferential composite path plan 
comprises an assembly of segments selected from at least two of the established 
perimeter plan, the established point-to-point path plan, and the established region- 
filling path plan; an order of the assembly based on coordination that minimizes an 
overall composite economic cost of the preferential composite path plan. 
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